//
// Created by jiangbin on 4/22/21.
//

#ifndef OPH_ROBOT_ROBOT_ARM_H
#define OPH_ROBOT_ROBOT_ARM_H

typedef	enum {
    ARM_L_E		= 0,	//左边舵机
    ARM_R_E		= 1,	//右边舵机
    ARM_C_E		= 2,	//中间舵机
}ARM_CTL_E;

#define ARM_CENTER 150

#define ARM_MIN_L 60
#define ARM_MAX_L 160
#define ARM_MIN_R 60
#define ARM_MAX_R 160
#define ARM_MIN_C 135
#define ARM_MAX_C 165

void robot_arm_init(void);
void robot_arm_exit(void);
int robot_set_pos(int pos_l, int pos_r, int pos_c);
void arm_01(void);

#endif //OPH_ROBOT_ROBOT_ARM_H
